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^ start LSQ Fix^ 
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Perform Least- 
Squares 
iterations 



Compiite DDR2 
for Alternate Fix 



This test catches the 
case where the 
alternate nx least- 
squares Iteration 
converges to the 
spme point as the 
initial fix. Inthatcas 
the alternate root 
has not been 
Identifled and the fix 
Is rejected for safety 



The 
number of 
SVs Is 3 
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we have 
checked 
for any 
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algorithm 
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number 
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Nav Library DGPS Mode Selection 
Executed before measurement processing in each navigation cycle 

Assuming Nav DGPS Degraded Timeout « 0 
start with UseDGPS ^ True or False from Last Nav Cycle 
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Degraded Mode Filter Processing 
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Nav Library Main 



^ start ^ 



Query LP cycle status 

Get current Nav Internals, 
Control. Navstate and time step 



Propagate the clocH states 
forward 



Propagate Kalman ECEF 
position states: 
Pos = Pos + Vel*dt ' 



Convert updated ECEF 
position to iat, Ion. alt 



Compute Earth to NED PCM 
from iat, Ion 



Correct Receiver Managers 
week and time of weelc 
(swweeic and swtow) with the 
Katman filter dock bias 
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Override 'autocorrelation test In 
progress' flags 




Auto correlation test in 
progress « TRUE 
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Save channers current lono, 
PR validity and Pseudorange 
as previous: 
OidlOno = iono . 
OldPR Pseudorange 
OldPRValld » PRValld 




tono = nnax(C 


),lono delay) 
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Extrapolate the state of the 
transmitter 






Post SV state. l.e. save 
diannel data In NLSVStates 



lono = 0 

1 .. 



KF.ExtrapSVState 




Save nev^ SVID for channel 
Clear old lono. PR, validity 



Reset channel SA Track 

Valid ^ PAUSE 
Bias = 0 
Rale - 0 
Age-0 




lono = MAX(0, ionospheric 

delay for this SV) 
lonoChange = Oldlono - lono 
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Perform PR/DR consistency 
check 
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Buffer DGPS data from 
Receiver Manager 
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(PRValld OR DRValld) 
AND Channel passed all 
ecfltUng tests 



Compute range, LOS, and 
doppler estimate. 



NL.RangeUpdate 



Compute Tropo correction based on 
altitude and sinelev: 

If alt <= -500 • 
Tropexp- 1.075154 
else 

Tropexp = e**^ . 

Ifslhetev<'0.0264055 
Tropo = 83,61 8958 * Tropexp 
else 

Tropo = 2.206 * Tropexp / mln (sinelev. 1) 



Compute PR residual 

PRResldual b Pseudorange • Range 

- ClocKBias * NLC 
4- SVCIkBias * NLC 

- Tropo -tono " 



NLC B speed of light, nVs 
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'^NABLE^GROSS^PR.EDir 



GR0SS.PR^ED1T 
(for offline processing) 




Large PR Residual - 
Something Is wrong - 
YES check for a msec error 
__t 



Compute PRResidual in msec 
mscouht = round(PRResldual / (NLC/1000)) 

and subtract 1 msec from the PRResidual 
msresid = PRResidual - mscounr NLC/1000 
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Reset channel SA Track 

Valid = FALSE 
Blas = 0 
Rate = 0 
Age = 0 



Set Error indicating Gross PR Residual Edit 
EdltFlag = GROSS_PR_RESIDL)AL 
NumEdlt++ 




FIG. 8D 



Nav Library Main 




Compute DR Residual 

DRResidual « DeltaRange 
+ DopplerEst 
-ClockDrtffNLC 



NO 



PRValid AND 
"(Ephnag=1)AND(slner 
>ssin(ElevNavMask) 
(EdltnaflsO); 

ElevNavMask default - 7.5 deg 



Increment Number of Total Meas 
Meas to Process = True 
Ready to Process = TRUE 
lonoshlft = lonoshlft+lonochange^ 




nlmaln.DGPS_Declslon.vsd 
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Recompute the residuals to use 
the corrections In D6PS mode 



Ready to Process 
Ready to Process AND PGPSAvall 
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.ClockBias*NLC 
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. Tropo ^ 
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PRResldual 
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dgpsPRCorrection 



DRRestdual - DRResidual 

+ dgps.PRRCorrection 



Loop for 12 
channels 
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Perform A-PrloriRAIMtesl 
NumRAIMEdIt « Number of RAIM 
edits • 



Compute apparent time shift and 
apparent frequency shift 
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Too many edits - resetting nav 
validation flags (Error Condition) 
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